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Translational and Scaling Formation Maneuver 
Control via a Bearing-Based Approach 

Shiyu Zhao and Daniel Zelazo 


Abstract —This paper studies distributed maneuver control of 
multi-agent formations in arbitrary dimensions. The objective 
is to control the translation and scale of the formation while 
maintaining the desired formation pattern. Unlike conventional 
approaches where the target formation is defined by relative po¬ 
sitions or distances, we propose a novel bearing-based approach 
where the target formation is defined by inter-neighbor bearings. 
Since the bearings are invariant to the translation and scale of the 
formation, the bearing-based approach provides a simple solution 
to the problem of translational and scaling formation maneuver 
control. Linear formation control laws for double-integrator 
dynamics are proposed and the global formation stability is ana¬ 
lyzed. This paper also studies bearing-based formation control in 
the presence of practical problems including input disturbances, 
acceleration saturation, and collision avoidance. The theoretical 
results are illustrated with numerical simulations. 

1. Introduction 

Existing approaches to multi-agent formation control can be 
categorized by how the desired geometric pattern of the target 
formation is defined. In two popular approaches, the target 
formation is defined by inter-neighbor relative positions or 
distances (see [1] for an overview). It is notable that the invari¬ 
ance of the constraints of the target formation has an important 
impact on the formation maneuverability. For example, since 
the relative-position constraints are invariant to the translation 
of the formation, the relative-position-based approach can be 
applied to realize translational formation maneuvers (see, for 
example, [2]). Since distance constraints are invariant to both 
translation and rotation of the formation, the distance-based 
approach can be applied to realize translational and rotational 
formation maneuvers (see, for example, [3]). 

In addition to the above two approaches, there has been 
a growing research interest in a bearing-based formation 
control approach in recent years [4]-[7]. In the bearing-based 
approach, the geometric pattern of the target formation is 
defined by inter-neighbor bearings. Since the bearings are 
invariant to the translation and scale of the formation, the 
bearing-based approach provides a simple solution to the prob¬ 
lem of translational and scaling formation maneuver control. 
Translational maneuvers refer to when the agents move at 
a common velocity such that the formation translates as a 
rigid body. Scaling maneuvers refer to when the formation 
scale, which is defined as the average distance from the 
agents to the formation centroid, varies while the geometric 
pattern of the formation is preserved. It is worth mentioning 
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that the bearing-based formation control studied in this paper 
requires relative-position or velocity measurements, which 
differs from the bearing-only formation control problem where 
the feedback control relies only on bearing measurements [8]- 
[16]. Moreover, bearing-based formation control is a linear 
control problem whereas bearing-only formation control is 
nonlinear. 

Formation scale control is a useful technique in practical 
formation control tasks. By adjusting the scale of a formation, 
a team of agents can dynamically respond to their surrounding 
environment to, for example, avoid obstacles. The problem 
of formation scale control has been studied by the relative- 
position and distance-based approaches in [17], [18]. However, 
since neither the relative positions nor distances are invariant to 
the formation scale, these two approaches result in complicated 
estimation and control schemes in which follower agents 
must estimate the desired formation scale known only by 
leader agents. Moreover, the two approaches are so far only 
applicable in the case where the desired formation scale is 
constant. Very recently, the work [19] proposed a formation 
control approach based on the complex Faplacian matrix. In 
this approach, the target formation is defined by complex linear 
constraints that are invariant to the translation, rotation, and 
scale of the formation. As a result, this approach provides a 
simple solution to formation scale control. However, as shown 
in [19], the approach is only applicable to formation control 
in the plane; it is unclear if it can be extended to higher 
dimensions. 

Although the bearing-based approach provides a simple 
solution to formation scale control, the existing studies on 
bearing-based formation control focus mainly on the case of 
static target formations. The case where the translation and 
scale of the target formation are time-varying has not yet been 
studied. Moreover, a fundamental problem, which has not been 
solved in the existing literature, is when the target formation 
can be uniquely determined by the inter-neighbor bearings 
and leaders in arbitrary dimensional spaces. The analysis of 
this fundamental problem requires the bearing rigidity theory 
proposed in [16] and was addressed in our recent work in 
[20]. Our previous work [21] considered a single-integrator 
dynamic model of the agents and proposed a proportional- 
integral bearing-based formation maneuver control law. 

The contributions of this paper are summarized as below. 
Firstly, we study the problem when a target formation can 
be uniquely determined by inter-neighbor bearings and leader 
agents. The necessary and sufficient condition for uniqueness 
of the target formation is analyzed based on a special matrix 
we term the bearing Laplacian, which characterizes both 
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the interconnection topology and the inter-neighbor bearings 
of the formation. Secondly, we propose two linear bearing- 
based formation control laws for double-integrator dynamics. 
With these two control laws, the formation can track constant 
or time-varying leader velocities. In the proposed control 
laws, the desired translational and scaling maneuver is only 
known to the leaders and the followers are not required to 
estimate it. A global formation stability analysis is presented 
for each of the control laws. Thirdly, we study bearing-based 
formation control in the presence of some practical issues. 
In particular, control laws that can handle constant input 
disturbances and acceleration saturation are proposed and their 
global stability is analyzed. Sufficient conditions that ensure no 
collision between any two agents are also proposed. Finally, 
it is noteworthy that the results presented in this paper are 
applicable to formation control in arbitrary dimensions. 

The organization of this paper is as follows. Section II 
presents the problem formulation. Section III proposes and 
analyzes two linear bearing-based formation control laws. 
Section IV considers bearing-based formation control in the 
presence of practical issues such as input disturbances and 
acceleration saturation. Conclusions are drawn in Section V. 

II. The Formation Maneuver Control Problem 
AND Bearing-Constrained Target Formations 

Consider a formation of n agents in (n > 2, d > 2). 
Let V = {1,. ■ • ,n}. Denote Pi{t) € and Vi(t) G as 
the position and velocity of agent i G V. Let the first 
agents be termed the leaders and the remaining n/ agents the 
followers {ni + Uf = n). Let Vt = {1, • •. ,n^} and V/ = 
{n^ -I- 1,..., n} be the index sets of the leaders and followers, 
respectively. The motion (i.e., position and velocity) of each 
leader is given a priori, and we assume the velocity of each 
leader is piecewise continuously differentiable. Each follower 
is modeled as a double-integrator, 

Pi{t) = Vi{t), Vi{f) = i G Vf, 

where Ui{t) G is the acceleration input to be designed. 
Let p, = [pl,...,plf, pf = [pl^^„...,pir, V, = 
and Vf = ..., vir. Let p = [pj,pjV 

and V = [vj , vj]^ ■ 

The underlying information flow among the agents is de¬ 
scribed by a fixed graph Q — (V, £) where £ C V x V is the 
edge set. By mapping the point pi to the vertex i, we denote 
the formation as G{p)- If (*,j) € £, agent i can access to 
the information of agent j. The set of neighbors of agent i is 
denoted as Afi = {j G V : {i,j) G £}. We assume that the 
information flow between any two followers is bidirectional. 
The bearing of agent j relative to agent i is described by the 
unit vector 

A Pj - Pi 
\\Pj-Pi\\' 

Note gji = —gij. For py, define 
^aij — Id — 

where Id € is the identity matrix. Note that Pg.. is 

an orthogonal projection matrix that geometrically projects 
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Fig. 1: An illustration of the bearing-constrained target formation. Solid dots: 
leaders; hollow dots: followers. Figure (a) shows the target formation p* and 
the real formation p. Figure (b) shows two target formations that have the 
same bearings but different translations and scales. 

any vector onto the orthogonal compliment of Pg^j. It can 
be verified that Pg. is positive semi-definite and satisfies 
= Pair = Pg^r Null(Fg,J = span{py }. 

A. Bearing-Based Formation Maneuver Control 

Suppose the real bearings of the formation at time t > 0 
are and the desired constant bearings are 

{9ij}{i,j)eE- The bearing-based formation control problem is 
formally stated below. 

Problem 1 (Bearing-Based Formation Maneuver Control). 
Consider a formation G{p(t)) where the (time-varying) posi¬ 
tion and velocity of the leaders, <dnd {vi(t)}i^Vr 

are given. Design the acceleration control input Ui{t) for 
each follower i GVf based on the relative position {pi{f) — 
Pj(f)}j^ff. and the relative velocity {vi{t) — Vj{f)}j^j^f^ such 
that 9ij(t) -G g*j for all (i,j) G £ as t ^ oo. 

Problem 1 can be equivalently stated as a problem where 
the formation is required to converge to a bearing-constrained 
target formation as defined below. 

Definition 1 (Target Formation). The target formation denoted 
by G(p*(t)) is a formation that satisfies the following con¬ 
straints for all t > 0.' 

(a) Bearing: {p*{t)-p*(f))/\\p*(f)-pl{f)\\ = gl,\/{i,j) G £, 

(b) Leader: p*{f) =pi(t),yi G V£. 

The target formation Q(p*(t)) is constrained jointly by 
the bearing constraints and the leader positions. The bearing 
constraints are constant, but the leader positions may be time- 
varying. Given appropriate motion of the leaders, the target 
formation has the desired translational and scaling maneuver 
and desired inter-neighbor bearings. If the real formation p{f) 
converges to the target formation p*{t), the desired forma¬ 
tion maneuver and formation pattern can be simultaneously 
achieved. Motivated by this idea, define the position and 
velocity errors for the followers as 

=Pfit) -P*fit), ^vit) =Vf(t) -V*f{t), (1) 

where p*f{t) and are the position and velocity of the 

followers in the target formation. The control objective is to 
design control laws for the followers to drive 6p{t) -G 0 and 
Sv{t) —>■ 0 as t ^ oo (see Figure 1 for an illustration). Note 
Spit) = Sy(t). 

A fundamental problem regarding the target formation, 
which is still unexplored so far, is whether or not p* (t) exists 
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Fig. 2: Examples of non-unique and unique target formations. Solid dots: 
leaders; hollow dots: followers. The formation in (c) is three-dimensional. 


and is unique. If p* (t) is not unique, there exist multiple for¬ 
mations satisfying the bearing constraints and leader positions, 
and consequently the formation may not be able to converge 
to the desired geometric pattern. This fundamental problem is 
analyzed in the following subsection. 


B. Properties of the Target Formation 

This subsection explores the properties of the target forma¬ 
tion that will be used throughout the paper. 

1) Bearing Laplacian Matrix: Define a matrix .8(G(p*)) G 
jgdnxdn of submatrix as 

Jj i.hj) G 

The matrix B{G{p*)), which we write in short as B in the 
sequel, can be viewed as a matrix-weighted graph Laplacian 
matrix, where the matrix weight for each edge is a positive 
semi-definite orthogonal projection matrix. We call B the 
bearing Laplacian since it characterizes both the interconnec¬ 
tion topology and the bearings of the formation. The bearing 
Laplacian matrix naturally emerges and plays important roles 
in bearing-based formation control and network localization 
problems [6], [20], [21]. 

We now state an important property of the bearing Lapla¬ 
cian. In the following, 1„ G M" is the vector with all entries 
equal to one, and 0 denotes the Kronecker matrix product. 

Lemma 1. For any G{p*), the bearing Laplacian always 
satisfies 

Null(8) 3 span{l„ ® h^P*)- (2) 

Proof For any x = [xf,..., x^Y" ^ we have 


Bx = 





(3) 


Firstly, if x G span{l„ 0 7^}, then Xi = Xj for all i,j G V. It 
then follows from (3) that Bx = 0. Secondly, if x G span{p*}, 
then Xi = kp* for all z G V where fc G K. It then follows 
from Pg*, {p* — p*) = 0 that Bx = 0. To sum up, any vector 
in span{l„ 0 Id,P*} is also in Null(8). □ 

Remark 1. In fact, any vector in the null space of B 
corresponds to a motion of the formation that preserves all 
the bearings [20], As a result, the expression in (2) indicates 


that the bearings are invariant to the translational and scaling 
motion of the formation. Specifically, 1„ 0 Id corresponds to 
the translational motion and p* — 1„ 0 {YYi=iPi /‘Y corre¬ 
sponds to the scaling motion. In addition, the bearings may 
also be invariant to other bearing-preserving motions (see, 
for example. Figure 2(a)). It is of great interest to understand 
when Null(8) exactly equals span{l„ 0 Id,P*}- As shown in 
[20], when Q is undirected, Null(8) = span{l„ ® Id^P*} if 
and only if Q (p) is infinitesimally bearing rigid. The definition 
of the infinitesimal bearing rigidity and preliminaries to the 
bearing rigidity theory are given in the appendix. 


We continue with the analysis by partitioning B as 


B = 


Bu Bif 

Bp Bff \ ’ 


where Bu G Rdnexdm^ g ^dntxduf g ^dnfXdui^ 

and BffG As will be shown later, the submatrix 

Bff plays an important role in this work. 


Lemma 2. The submatrix Bff G is symmetric and 

positive semi-definite. 


Proof. The submatrix Bff can be written as 8// = 8o + 7? 
where Bq G is the bearing Laplacian for the sub¬ 
graph of the followers and T) G is a positive semi- 

definite block-diagonal matrix with \D\ii — 
for i G V/. Note Bq is symmetric because the edges 
among the followers are assumed to be bidirectional. For 
any x = [x^,..., G we have x'^B^x = 

EiGV /WPgfYi “ ^])\\^ ^ 0 and hence Bq is 
positive semi-definite. Since T> is also positive semi-definite, 
the matrix Bff is positive semi-definite. □ 


2) Uniqueness of the Target Formation: Based on the bear¬ 
ing Laplacian, we can analyze the existence and uniqueness 
of the target formation p* (i.e., the existence and uniqueness 
of solutions to the equations in Definition 1). The bearing 
constraints and leader positions are feasible if there exists at 
least one formation that satisfies them. Feasible bearings and 
leader positions may be calculated from an arbitrary formation 
configuration that has the desired geometric pattern. In general, 
given a set of feasible bearing constraints and leader positions, 
the target formation may not be unique (see, for example. 
Figure 2(a)). In fact, the uniqueness problem of the target 
formation is identical to the localizability problem in bearing- 
only network localization [20]. We next give the necessary and 
sufficient condition for uniqueness of the target formation. 

Theorem 1 (Uniqueness of the Target Formation). Given 
feasible bearing constraints and leader positions, the target 
formation in Definition 1 is unique if and only if Bff is non¬ 
singular. When Bff is nonsingular, the position and velocity of 
the followers in the target formation are uniquely determined 
as 

p*f{f) = -BjjBfiPi{t), v*f(t) = -BjlBfeve(t). (4) 

Proof. As shown in [20], the target formation is uniquely 
determined by the bearings and leader positions if and only if 
Bff is nonsingular. It follows from Lemma 1 that Bp* = 0, 
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which further implies Bffp*^ + Bfipi = 0. When Bff 
is nonsingular, pj- = —Bj^Bfipe. Then, vj = pj = 
-Bj^Bfgve. □ 


A variety of other conditions for uniqueness of the target 
formation can be found in [20]. Here we highlight two useful 
conditions. A useful necessary condition is that a unique 
target formation must have at least two leaders. In this paper, 
we always assume there exist at least two leaders. A useful 
sufficient condition is that the target formation is unique if it 
is infinitesimally bearing rigid and has at least two leaders. 
By the sufficient condition, in order to design a unique target 
formation, we can first design an infinitesimally bearing rigid 
formation and then arbitrarily assign two agents as leaders. 
Figure 2(b)-(c) shows examples of unique target formations 
(more examples can be found in [20]). For the analysis in the 
sequel, we adopt the following uniqueness assumption. 

Assumption 1. The target formation Q{j)*(t)) is unique for 
all f > 0, which means Bff is nonsingular. 

3) Target Formation Maneuvering: In bearing-based for¬ 
mation maneuver control, the desired translational and scaling 
maneuver of the formation is known only to the leaders. In 
order to achieve the desired maneuvers, the leaders must have 
appropriate motions. We now study how the leaders should 
move to achieve the desired maneuvers of the target formation. 
Formation control laws will be designed later such that the real 
formation is steered to track the target formation. 

To describe the translational and scaling maneuvers, we 
define the centroid, c{p*{t)), and the scale, s{p*{t)), for the 
target formation as 

= -^p-(0 = ^ (In (^Idfp*{t), 

n n 

i^V 

V iev 

= ^||p*(f)-l„®c(p*(f))|l. 
s/n 

The desired maneuvering dynamics of the centroid and scale 
of the target formation are given by 

c{p*{t)) = Veit), s(p*(f)) = a(f)s(p*(f)), (5) 

where vdt) G denotes the desired velocity common to 
all agents and af) e M is the varying rate of the scale. The 
formation scale expands when a{t) > 0 and contracts when 
af) < 0. Suppose vdt) and ait) are known by the leaders. 
We next show how the leaders should move to achieve the 
desired dynamics in (5). 

Theorem 2 (Target Formation Maneuvering). The desired 
dynamics of the centroid and the scale given in (5) are 
achieved if the velocities of the leaders have the form of 

v^it) = vdt)Faif)[p^it)-cip*if))], iGVi- (6) 

Proof The vector form of (6) is vdt) = <8 vdt) + 

aif)[pdt) - Ine ® c(p*(f))]. Since span{l„ 0 Id,p*} C 


Null(,B) as given in Lemma 1, we have 


Biln 0 vdt) + aidipdt) -ln0 c(p*(f)))) = 0. 


The above equation implies BffVi + Bff[lnf 0 vdt) + 
ait)[p*fit) — Inj ® c(p*(f)))] = 0. Then Vfd) is calculated as 

Vfit) = BjfBfivdt) 

= Inf 0 vdt) + ait)[p*fit) - Inf 0 c(p*(f))], 


whose elementwise form is w*(f) = vdt) + a(f)(p*(f) — 
c(p*(f))) for all i G Vf. Note p* = bj, = 1„ (g) 

vdt) + ait)ip* — 1„ (g) c(p*)). Substituting p* into c(p*) and 
s(p*) gives 


dp*) = -(In (g) Id)^P* 
n 

= ^(l„ (g) Id)'^[^n 0 vdt) + Oiidip* - 1„ (g) C(p*))] 
= -(!„ (g) Id)'^dn 0 vdt)) = vdt), 

n 


sip*) 


1 (p*-l„0c(p*))^ 

Vn Up* - i„(g)c(p*)|| 

1 (p*-l„0c(p*))^ 
dn Up* - 1„ (g) c(p*)|| 


(p* - In 0 vdt)) 
ait)ip* - In 0 dp*)) 


a(f)s(p*). 


□ 


As shown in (6), the velocity of each leader should be a 
linear combination of the common translational velocity and 
the velocity induced by the scaling variation. In addition to 
vdt) and af), each leader should also know the centroid 
c(p*(f)), which is a global information of the target formation. 
This quantity may be estimated in a distributed way using, for 
example, consensus filters, as described in [22]. 


III. Bearing-Based Formation Control Laws 

In this section, we propose two distributed control laws to 
steer the followers to track the maneuvering target formation. 
The first control law requires relative position and velocity 
feedback; with this control law the formation tracks target 
formations with constant velocities. The second control law 
requires position, velocity, and acceleration feedback; with this 
control law the formation tracks target formations with time- 
varying velocities. 


A. Formation Maneuvering with Constant Leader Velocity 

The bearing-based control law for follower i G V/ is 
proposed as 

Vi = - Pg*. [kpiPi -Pj)+ KiVi - Vj)] , (7) 

where Pg*, = Id—9*jig*j)"'" is a constant orthogonal projection 
matrix, and kp and ky are positive constant control gains. 
Several remarks on the control law are given below. Firstly, 
the neighbor j € A/) of agent i may be either a follower 
or a leader. Secondly, the proposed control law has a clear 
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Pgh (Pj - pi) 


--o 

Pj 


PiO- 




9ij 


Fig. 3: The geometric meaning of the term Pg* (pj —pi) in control law (7). 


geometric meaning illustrated in Figure 3: the control term 
Pg*.{pj — Pi) Steers agent i to a position where pij is aligned 
with g*j. Thirdly, the proposed control law has a similar form 
as the second-order linear consensus protocols [23]-[25]. The 
difference is that, in the consensus protocols the weight for 
each edge is a positive scalar, whereas in the proposed control 
law the weight for each edge is a positive semi-definite orthog¬ 
onal projection matrix. It is precisely the special properties 
of the projection matrices that allows the proposed control 
law to solve the bearing-based formation control problem. The 
convergence of control law (7) is analyzed below. 

Theorem 3. Under control law (7), when the leader velocity 
Vi{t) is constant, the tracking errors 6p{t) and Sy{t) as defined 
in (1) globally and exponentially converge to zero. 

Proof. With control law (7), the dynamics of the followers can 
be expressed in a matrix-vector form as 


Pf = -kpiBffPf + Bfipi) - KiBffVf + Bfivt) 

- ^pBf fSp kyBJySy J 


( 8 ) 


where the second equality is due to the fact that Sp = 
Pf + BjjBfipe and Sy = Vf + Bf^Bfivt, as shown in 
(4). Substituting (8) into the etTor dynamics gives 5y = 
Vf + BjjBfeV( = —kpBffSp — kyBffSy -I- BjjBfivi, which 
can be rewritten in a compact form as 



0 

—kpBff 


-kyB 


If J L 



\ s„ 1 


0 


1 

+ 

. _ 


Vi. 


(9) 


Let A be an eigenvalue of the state matrix of (9). The charac¬ 
teristic equation of the state matrix is given by det(A^/ + 
XkyBff + kpBff) = 0. It can be calculated that A = 
{—kypi: — Akpp)/2, where /i > 0 is an eigenvalue of 

Bff. Therefore, Re(A) < 0 for any kp, ky, p > 0. As a result, 
the state matrix is Hurwitz and hence Sp and Sy globally and 
exponentially converge to zero when Vi = 0. □ 

When Vi{t) is time-varying (i.e., ve{t) is not identically 
zero), the tracking errors may not converge to zero according 
to the error dynamics (9). In order to perfectly track target 
formations with time-varying Vi{f), additional acceleration 
feedback is required as shown in the next subsection. In 
practical tasks where the desired target formation has piece- 
wise constant velocities, the control law (7) may still give 
satisfactory performance. 

A simulation example is given in Figure 4 to illustrate 
control law (7). The target formation in this example is the 
square shown in Figure 2(b). There are two leaders and two 
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Fig. 4: A simulation example to demonstrate control law (7). 


followers. As shown in Figure 4(a)-(b), the translation and 
scale of the formation are continuously varying and, in the 
meantime, the desired formation pattern is maintained. In 
Figure 4(c), the x-velocity of each follower converges to a 
value smaller than that of the leaders, because the velocity 
of a follower is a combination of the translational and scaling 
velocities and the scaling velocity in the x-direction is negative 
in this example. 


B. Formation Maneuvering with Time-Varying Leader Velocity 

Now consider the case where Vi(t) is time-varying (i.e., 
vi{f) is not identically zero). Assume vi{t) is piecewise con¬ 
tinuous. The following control law handles the time-varying 
case, 

Ui = —Ki 'y ' i^piPi ~ Pj) ky{Vi — Vj) — Vj\ , (10) 
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where Ki — ■ Compared to control law (7), control 

law (10) requires the acceleration of each neighbor. The design 
of control law (10) is inspired by the consensus protocols for 
tracking time-varying references as proposed in [2], [23]. The 
nonsingularity of Ki is guaranteed by the uniqueness of the 
target formation as shown in the following result. 

Lemma 3. The matrix Ki is nonsingular for all i GVf if the 
target formation is unique. 

Proof First of all, the matrix Ki is singular if and only if 
the bearings {g*j}j^j\/i are collinear, because for any x G 
x’^KiX = 0 = 0 Pg^.X = 0,Vj € 

Afi. Since Null(Pg*.) = span{(7*j}, we know x^'^KiX = 0 if 
and only if x and {p*j}jG7V"i are collinear. If {p*j}jG7Vi are 
collinear, the follower p* cannot be uniquely determined in 
the target formation because p* can move along g*j without 
changing any bearings. As a result, if Ki is singular, the target 
formation is not unique. □ 

The convergence of control law (10) is analyzed below. 

Theorem 4. Under control law (10), for any time-varying 
leader velocity vi(t), the tracking errors Sp(t) and Sy(t) as 
defined in (1) globally and exponentially converge to zero. 

Proof. Multiplying Ki on both sides of control law (10) gives 

~ ^3^ = 51 [-hiPi - Pj) - ^v{Vi - , 

jeKi 

whose matrix-vector form is 

PffVf + BfiVi = -kp{BffPf + Bfm) - ky{BffVf -f Bfm) 
— kpB f fdp kyBfjSy. 

It follows that Vf = —kp6p — kySy—BjjBfiVi. Then the track¬ 
ing error dynamics are Sp = Sy and (5„ = Vf Bj^Bf^v^ = 
—kpSp -f kySy, which are expressed in a compact form as 


5p 


0 

I 


Sp 

Sy 


-kpl 

kyl 


Sy 


The eigenvalue of the state matrix is A = (—± 

s/k"^ — Akp)/2, which is always in the open left-half plane 
for any kp,ky > 0. The global and exponential convergence 
result follows. □ 



(a) Trajectory (The dark area stands for an obstacle.) 


kp=1, kv=3 




Time (sec) 


(c) Velocity 

Fig. 5: A simulation example to demonstrate control law (10). 


as passing through narrow passages. In practice, collision 
avoidance requires sophisticated mechanisms such as obstacle 
detection and path generation (see, for example, [26]). Details 
on obstacle avoidance are out of the scope of this paper. 


By comparing the error dynamics in (11) and (9), we see 
that the role of the acceleration feedback in control law (10) 
is to eliminate the term that contains V£{t) so that it does not 
affect the convergence of the errors. 

A simulation example is shown in Figure 5 to illustrate 
control law (10). The target formation in this example is the 
three-dimensional cube shown in Figure 2(c), which has two 
leaders and six followers. As shown in Figure 5(a)-(b), the 
translation and scale of the formation are continuously varying 
and, in the meantime, the formation converges from an initial 
configuration to the desired pattern. Although the velocities of 
the leaders are time-varying, the desired formation pattern is 
maintained exactly during the formation evolution. 

The simulation example also demonstrates that the pro¬ 
posed control law can be used for obstacle avoidance, such 


IV. Bearing-Based Formation Control with 
Practical Issues 

In this section, we consider bearing-based formation control 
in the presence of some issues that may appear in practical im¬ 
plementations, including input disturbances, input saturation, 
and collision avoidance among the agents. 

A. Constant Input Disturbance 

Suppose there exists an unknown constant input disturbance 
for each follower. The dynamics of follower i G Vf are 

Pi = Vi, Vi=Ui+ Wj, 

where G is an unknown constant signal, and let = 
\vfj,... . In practice, the constant input disturbance 
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might be caused by, for example, constant sensor or actuator 
biases. In order to handle the input disturbance, we add an 
integral control term to control law (7) and obtain 


Ui = 






kp{Pi - Pj) + ky{vi - Vj) 


+ ki {pi-pj)dT , 

Jo 


( 12 ) 


where kj > 0 is the constant integral control gain. We next 
show that the integral control will not only eliminate the 
impact of the constant disturbance but will also handle the 
case where ve{t) is nonzero and constant. 


Theorem 5. Consider the control law (12) with constant 
disturbance Wf and constant leader acceleration V£. If the 
control gains satisfy 0 < kj < kpkvXmin{Bff), then the 
tracking errors 6 p{t) and 6 ^( 1 ) globally and exponentially 
converge to zero. 


Proof The matrix-vector form of control law (12) is 

= -ki / (BffPf + Bfepi)dT - kp{BffPf + Bfm) 

JO 

- kv{BffPf + BfiPi) + Wf 

= —kiBff / Spdr — kpBffSp — kyBffSy +Wf. 

Jo 

Denote rj = Spdr. It then follows that f] = Sp, Sp = 6y, and 
Sy = Vf Bj:j:Bf£V£ = kjBffTj kpBffSp kyBffdy 
Wf + BjjBfiVi, the matrix-vector form of which is given by 


V 


0 

0 


V 

Sp 

= 

0 0/ 


Sp 

Sy 


—kjBff —kpBff —kyBff 


. 



0 


0 

+ 

0 

+ 

0 


. . 


-1 

_1 


Denote A as the state matrix of the above dynamics with 
A an associated eigenvalue. We next identify the condition 
for Re(A) < 0. Note the state matrix is in the controllable 
canonical form. Then the characteristic polynomial is 


det(A/ — A) = det(A^/ -I- kyBff)? -\- kpBffX + kiBff). 

As a result, A^ can be viewed as an eigenvalue of the matrix 
— {kyX’^ + kyX + ki)Bff. By denoting p, as an eigenvalue of 
Bff, we have A^ + kypX^ + kppX + kjp = 0. By the Routh- 
Hurwitz stability criterion, we have Re(A) < 0 if and only 
kyp,kpp,kip > 0 and {kyp)(kpp) > kip. Since ky,kp,p > 
0, we have 0 < fc/ < kykpp. In order to make Re(A) < 
0 for all p, it is required 0 < fc/ < kykpXynin{Bff) where 
Xmin{Bff) is the minimum eigenvalue of Bff. When A is 
Hurwitz, given constant wy and v/, the steady state is Sp{oo) = 
(5„(oo) = 0 and 77 ( 00 ) = —Bj^{wf + BfjBfivi)/k[. □ 


As can be seen from the error dynamics (13), when Vi is 
constant, it has the same impact as an input disturbance and 
hence is handled by the integral control. The idea of integral 
control has also been applied in consensus, distance-based 


and bearing-based formation maneuver control problems [ 21 ], 
[27], [28]. It is also interesting to note that the integral control 
gain must be bounded by Ai„in(^//)^ which we expect should 
have graph-theoretic interpretations and is the subject of future 
work. 

Similarly, by adding an integral control term to control law 
( 10 ), we obtain the following control law that can handle the 
unknown constant input disturbance and time-varying viif). 


E P 9 : 


kpiPi -Pj) + ky{vi - Vj) - Vj 


+ ki {pi-pj)dT 

Jo 


(14) 


The convergence result for control law (14) is given below. 
The proof is similar to Theorem 5 and omitted. 


Theorem 6 . Consider the control law (14) with constant 
disturbance Wf and time-varying leader velocity vi{t). If the 
control gains satisfy 0 < fc/ < kpky, then the tracking errors 
Sp{t) and 6 y(t) globally and exponentially converge to zero. 


B. Acceleration Saturation 

In practical implementations, the acceleration input is al¬ 
ways bounded. In the presence of acceleration saturation, the 
control law (7) becomes 


Ui = sat 


- E Pgf -P3') + - 

jeMi 



(15) 


where sat(-) is a saturation function that is either sat(a;) = 
sign(a;) min{|a 7 |,/?} or sat(x) = /3tanh(a;) where a; € M 
and /3 > 0 is the constant bound for |a;|. For a vector 
X = \xx,... ,xf\^ € M.9, sat(a;) is defined component-wise 
as sat(x) = [sat(a;i),..., sat(a;g)]^. 

Due to the saturation function, the formation dynamics 
become nonlinear and the formation stability can be proven 
by a Lyapunov approach. Inspired by the work in [25], we 
introduce the integral function $(a;) = sat(T)dT for a: € IR. 
Due to the properties of sat(-), we have that $(x) > 0 for 
all a; € IR and $(a;) = 0 if and only if a; = 0. In the case of 
sat(x) = /3tanh(a:), we have <l>(a;) = /3log(cosh(a;)). For a 
vector X = \xi,... ,Xq]"^ G IR"^, <l>(a;) is defined component¬ 
wise as 


<I)(a;) 



sat(T)dr,.. 



T 


sat (r) dr 


G IR9. 


The useful properties of $(•) and sat(-) are given below. 


Lemma 4. Given x{f) G IR^, the quantity l^<l>(a;) satisfies 

(a) l^<I>(a;) > 0 and l^<l>(a;) = 0 if and only if x = 0 . 

(b) d(l^<i>(x))/df = a:^sat(a;). 


Proof. Note l^<I)(a:) = J2i=i Since <I)(a:i) > 0 and 

T’ja;^) = 0 if and only if Xi = 0 , property (a) is proven. 
The time derivative of l^<I)(a;) is given by d(l^<i>(x))/df = 
J2i=i ^( 3 ;*) = J2i=i iisa,t{xi) = x'^sat{x). □ 


Lemma 5. For any two vectors x,y G IR®, it always holds that 
[sat(a; — y) — sat(x)] < 0 and y^ [sat(a;) — sat(a; -f y)] < 
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0. Moveover, if sat{-) is strictly monotonic, the equalities hold 
if and only if y = 0. 

Proof We only prove the first inequality; the second one 
can be proven similarly. Note (sat(a: — y) — sat(a;)) = 
X]i=i yi(sat(xi — yt) — sat(xi)). It follows from the mono¬ 
tonicity of the saturation function that sat{xi — yi) — sat{xi) > 

0 if yi < 0, and sat{xi—yi)—sat{xi) < 0 if > 0. Therefore, 
yi{sat{xi — yi) — sat(xi)) < 0 for all Xi,yi € K. If sat(-) is 
strictly monotonic, yi{sat{xi — yi) — sat(a;i)) = 0 if and only 
if yi = 0 , which completes the proof. □ 

With the above preparation, we now analyze the formation 
stability under control law (15). 

Theorem 7. Under control law (15) with a constant leader 
velocity vi{f), the tracking errors 6p{t) and 6v{t) globally and 
asymptotically converge to zero. 

Proof The matrix-vector form of control law (15) is Vf = 
sat{—kpBff6p — kyBffSv). Substituting vj and ve = 0 into 
the tracking error dynamics gives = Vf + BjjBfeve = 
sat{—kpBff6p — kvBffSy). Consider the Lyapunov function 

V = l'^^{-kpBff5p - k^uBffSy) + l'^^{-kpBff6p) 

“t“ kpSy BjySy. 

It follows from Lemma 4(a) that V > 0 and C = 0 if and only 
if Sp = Sy = 0. According to Lemma 4(b), the time derivative 
of the Lyapunov function is 

V = { — kpBffSy — kyBffSy)^Sat{ — kpBffSp — kyBjfSy) 
ff ^v) sat ( kpByySp) “t” ‘2kpSy ByySy. 

It follows from sat{—kpBffSp — kyBfjSy) = 6y that 

V = -{kpBff6y)’^Sy - {kyBff6y)’^Sy 

ff^v) Sat( kpByj-'Sp) “t“ ‘ZkpSy ByySy 
— ky6y ByySy (^kpByySy) sat( kpByySp) -f kpSy ByyS^ 

= -kySyByySy 

+ kpSy Byy[sat{—kpByySp — kyByySy) — Sat{—kpByy6p)], 

where the first term —kySy ByySy is nonpositive and the 
second term is also nonpositive according to Lemma 5. As 
a result, C < 0 for all t > 0. 

We next identify the invariant set for V = f). When V = 0, 
we have 

-ky6^ByySy = 0, (16) 

kp6yByy[5y - sat {-kpByySp)] = 0. (17) 

It follows from (16) that Sy = sat{—kpByySp — kyByySy) = 0, 
which further implies kpByySp = —kyByySy. It then follows 
from (17) that kpSy Byysat{—kyByySy) = 0, which indicates 
ByySy = 0 ()„ = 0 because ByySy and sat{ByySy) have 

the same sign componentwise. Since kpByySp = —kyByySy, 
we have Sp = 0. Therefore, C = 0 if and only if Sp = Sy = 0. 
According to the invariance principle, the tracking errors Sp 
and Sy globally and asymptotically converges to zero. □ 

In order to handle input saturation in the case of time- 


varying viit), we use the control law 

= Kf^sat \ ^ Pg'-. [kp{pi -Pj) + kyivi - Uj)] > 

i few ' J 

where Ki = Pg* ■ Although the saturation function is 

not applied to the entire acceleration input, the above control 
law ensures bounded input given arbitrary initial conditions. 
In particular, under control law (18) the velocity dynamics 
are Pg* i'^i ~ ’^j) — sat(*), where the quantity in 

the saturation function is written in short as sat(*). Then 
the matrix-vector form of the velocity dynamics is Byyvy -f 
Byyvt, = sat(*), which implies vy = Bjysat{-k) — Bj^Byivi. 
It follows that 

ll^/lloo < ||%i||oo||sat(*)||oo + \\BjlBy,\U\MU 

The upper bound for the acceleration as shown above is 
independent to the initial conditions of the formation position 
or velocity. It relies on the rigidity structure of the target 
formation and the magnitude of the accelerations of the 
leaders. We next characterize the global formation stability 
under control law (18). 

Theorem 8. Under control law (18) and for any time-varying 
leader velocity ve{t), the tracking errors Sp{f) and Sy{t) 
globally and asymptotically converge to zero. 

Proof. Let ^gfiPi ~ Pj)- follows from (18) 

that ii = sat{—kpSi — kyii). By denoting e = [ei,..., 
we obtain 

e = sat(—fcpE — kyi). 

Note e = Byypy ByiPi = ByySp and hence i = ByySy. As 
a result, e = e = 0 = 0. We prove Sp, —> 0 by 

showing £, e —)• 0. To that end, consider the Lyapunov function 

V = 1^$(—fcp£: — kyi) 1^$(—fcps) -I- kpE^i. 

The time derivative of V is given by 

V = {—kpi — kye)sat{—kpe — kyi) 

{—kpi)sat{—kp£) 2kp£^£ 

= —ky£^£ -f kpE^[sat{kp£) — satfkpE -\- kyS)]. 

Similar to the proof of Theorem 7, it can be shown that 1^ < 0 
and the invariant set where V = 0ise = e = 0. Therefore, by 
the invariance principle, e and i globally and asymptotically 
converge to zero, and so do Sp and Sy. □ 

C. A Collision-Free Condition 

Collision avoidance among the agents is an important issue 
in practical formation control problems. The proposed control 
laws can be implemented together with, for example, artificial 
potentials [29] to ensure collision avoidance. In this work, 
we propose a sufficient condition on the initial formation that 
ensures no collision between any pair of agents (even they are 
not neighbors). Suppose 7 is the desired minimum distance 
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that should be guaranteed between any two agents and 7 
satisfies 


0 < 7 < . min IbnO -Pj WII- 

Theorem 9. Under control law (7), for any constant leader 
velocity vi, it is guaranteed that 

Ibib) --Pj-WII > 7. Vt, j e v,vt > 0, 

if 5p{Q) and (5„(0) satisfy 

< ( .min „ llP.'(f) - p;m - 7 )' - (19) 

rif \i,]ev,t>o ■' J 

Proof For any i, j € V, it always holds that 

p^{f)-pJ{t) 

^ [p*(t)-p*(t)] + bbi) -Pib)] - b,b) 

where p* (t) and p* (t) are the expected positions for agents 
i and j in the target formation. Note pi (t) — p* (t) = 0 for 
t G V^. It follows that 


ib*b) -Pjb)ii 

> ibib) -p,*b)ii - \\p^it)-p*m - \\pjit)-p;m 
= M{t)-P*m-J2 \\Pk{t)-Pim 

kevj 

> ibib) -Pjb)ll - v^ib/b) -p/b)ll 

= ibib)-Pjb)ll - v^lbpb)ll( v<>o. (20) 

The above inequality gives a lower bound for \\pi{t) —Pj{t)\\. 
If we can find a condition such that the lower bound is 
always greater than 7, then the minimum distance 7 can be 
guaranteed. In this direction, consider the Lyapunov function 

V{6p(t),Sy{t)) = kpSp{t)Bff6p{t) + S'^it)6y{t). 

With the error dynamics as given in (9), the time derivative of 
V along the error dynamics is L = —2ky6yBffSv < 0. As a 
result, we have 


kpX^in{Bff)\\dp{t)f < kp6p{t)Bffdp{t) 

< kpSp {t)Bffdp(t) + 6y (t)dy{t) 
<V{6p{0),Sy{0)), 

which implies 


ibpb)ii < 


I V{6p{0),6y{0)) 

(^//) 


( 21 ) 


By combining (20) and (21), we have that \\piit)—pj{t)\\ > 7 
for all f > 0 and all i,j G 17 if (5p(0) and (5t,(0) satisfies 


■ .^b^nibib) -Pjb)ii -1 

which can be rewritten as (19). 


lnfV{Sp{0),6y{Q)) 

kpXuiini^B f f) 


> 7, 


□ 


The intuition behind the condition in Theorem 9 is that 
collision avoidance is guaranteed if the initial formation is 
sufficiently close to the target formation. Theorem 9 is merely 


applicable in the case of constant For time-varying viit), 
we have a similar condition for control law (10). The proof is 
similar to Theorem 9 and omitted. 

Theorem 10. Under control law (10), for any time-varying 
leader velocity V((t), it can be guaranteed that 

Ibib) -Pj-b)!! > 7 , Vi, j &vyt> 0 , 

if dp{0) and (5^(0) satisfy 

kpSp ( 0 )()p( 0 ) + 6y (0)5^(0) 

< — f. .min |b*b) -Pjb)ll - 7 ) • 

rif \i,jev,t>o / 

The sufficient conditions given in Theorems 9 and 10 are 
likely conservative in practice. For example, in the simulation 
example shown in Figure 4, no two agents collide during the 
formation evolution even though the inequality (19) does not 
hold. Specifically, the left-hand side of (19) equals 325.88, 
whereas the right-hand side with 7 = 0 equals 14.53. 

V. Conclusions 

This work proposed and analyzed a bearing-based approach 
to the problem of translational and scaling formation maneu¬ 
ver control in arbitrary dimensional spaces. We proposed a 
variety of bearing-based formation control laws and analyzed 
their global formation stability. There are several important 
directions for future research. For example, in this work we 
assume that the information flow between any two followers 
is bidirectional. In the directional case, a new notion termed 
bearing persistence emerges and plays an important role in 
the formation stability analysis [30]. Secondly, although the 
double-integrator dynamics can approximately model some 
practical physical systems, more complicated models such as 
nonholonomic models should be considered in the future. 

Appendix 

A. Preliminaries to Bearing Rigidity Theory 

Some basic concepts and results in the bearing rigidity 
theory are revisited here. Details can be found in [16]. For 
a formation Q{p) with undirected graph Q, assign a direction 
to each edge in Q to obtain an oriented graph. Express the 
edge vector and the bearing for the kth directed edge in 
the oriented graph, respectively, as Ck and gk = efc/||efc|| 
for k G m} where m = \S\. Define the bearing 

function Fb : ^ M"*™ as Fb(p) = 

The bearing rigidity matrix is defined as the Jacobian of 
the bearing function, Rb{p) — dFB{p)/dp G The 

bearing rigidity matrix satisfies rank(i?B) < dn — d — 1 and 
span{l (g) Id,p} C Null(i?B) [16]. Let 6p be a variation 
of p. If Rb{p)Sp = 0, then 6p is called an infinitesimal 
bearing motion of Gip)- A formation always has two kinds 
of trivial infinitesimal bearing motions: translation and scaling 
of the entire formation. A formation is called infinitesimally 
bearing rigid if all the infinitesimal bearing motions are trivial. 
The infinitesimal bearing rigidity has the following important 
properties. 
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Theorem 11 ([16]). The following statements are equivalent: 

(a) Q{p) is infinitesimally bearing rigid; 

(b) Q{p) can be uniquely determined up to a translational and 
scaling factor by the inter-neighbor bearings {gij}{ij)eS’' 

(c) rank(i?B) = dn — d — 1; 

(d) Null(i?B) = span{l„ (g) Id,p}- 
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